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APPENDIX D. TRAJECTORY 4 RESULTS 



1 .1 PIPS Conceptual Design 
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PIPS is an automated system which will be programmed off-line. Path planning is critical for PIPS to avoid 
contact in the cluttered Shuttle payload environment. The robotics literature is rich with path planning and 
obstacle avoidance techniques (e.g. [61, [71, [8], (91). Path planning for this project is divided into two phases: 1) 
Determination of collision-free manipulator tip trajectories to reach required goal points. 2) Development and 



implementation of a follow-the-leader (FTL) algorithm which forces ensuing links to follow the same tip trajectory. 
Given an obstacle-free manipulator tip trajectory, the FTL algorithm ensures whole-arm collision avoidance. The 
nnth nlnnnine algorithm must be constrained to vield trajectories which are achievable using the FTL algorithm 



FTL algorithm development, MATLAB implementation, and testing 
High-fidelity prototype hardware modeling in IGRIP (with Carey Cooper) to demonstrate FTL 
Kinematics modeling and information compilation for prototype hardware 
Worked with programmer to implement FTL algorithm in C++ 

Preliminary development for path planning algorithm 


This report is organized as follows. Section II presents kinematic modeling and information compilation 
for the prototype PIPS hardware, plus a discussion of the developed IGRIP model. Section HI presents the general 
FTL algorithm. The subsections give detailed derivations of the required mathematics. Section HI concludes with 
simulated results. The conclusion follows, including a summary of design lessons learned from simulation. The 
last section is references. Four appendices are given to support the text. 
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2.1 MODIFIED FOSTER-MILLER HARDWARE 



Figure 2. 1 Motion Base for Prototype STM 



The STM is a sixteen-dof tetrahedral variable geometry truss (VGT) as shown in Fig. 2.2. The rotation 
axes are orthogonal, rather than spaced by 120° as in the standard tetrahedron VGT from the literature [10]. The 
comers of the solid tetrahedra along the manipulator from base to tip, opposite the linear actuators, are called the 
spine of the STM. Figure 2.2 is mirror-image of the as-built hardware. Figure 2.3 depicts the prototype hardware 
geometry. 
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As shown in Eq. 2.1, a homogeneous transformation matrix is composed of a rotation matrix representing the 
orientation and a position vector the translation between two frames. An artificial fourth row is added to maintain 
proper mathematical operations. Given all ,- *T , the forward kinematics transformation is: 



Figure 2.3 Kinematic Diagram for Prototype STM 
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and inverse kinematics solutions. The FTL discussion concludes with presentation of simulated results. 




3.3.1 SPINE POINTS 

Given an STM to control in FTL mode, the first step is to determine which points to control as the spine points. 
Since three dof are required to position a point independently in 3D space, the first serpentine joint, 3 , is 
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The equation of a sphere with radius r and center x e ,y e ,z e is: 

(x-x c ) 2 +(y-y c ) 2 +(z-z c ) 2 =r 2 (3.6) 



The intersection of the sphere surface and tine segment is found by substituting x,y,z from Eq. 3.5 into Eq. 



The motion base inverse position problem is: Given 0 P 4 , calculate d x ,6 2 ,0 3 • The associated DH parameters are 
the first three lines in Table A.l. The kinematic diagram is shown in Fig. 2.1. Equation 3.9 gives the 
transformation relating the variables to the given information. 
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The general module inverse kinematics problem is: Given two consecutive spine point locations, plus*4he 
previous joint values, calculate 9 ^ >0 Oi . The vector difference between neighboring spine points can be expressed 

in two ways: 






In Eq. 3.20, the left-hand-side is known, while the right-hand-side contains the unknowns 0 m ,0oi- Solution of 
these unknown joint angles is obtained by equating like components. 0 Bi is solved from a ratio of the z to the x 
component. The four-quadrant inverse tangent function, atan2, must be used in Eq. 3.21. 
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This section di sc wre* FTL algorithm simulation results for the prototype fit's naraware. nus cuou wa» 
accomplished using MATLAB, C++, and IGRIP . 
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APPENDIX A. DEN AVIT -HARTENBERG PARAMETERS 
FOR THE PROTOTYPE PIPS HARDWARE 
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Table A.2 gives specific data for the seven Modules / (Segment /-/+/) for the prototype STM; see Table 
3:2. Modules 1,2 and 4,5 are identical. For each module, the DH lengths are given (see Table A.1). Also, 
information on the variable module length Q t is included: 
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NASA-modified STM must be determined. 




APPENDIX B. MATLABCODE 



SPHRLINE.M (INTRSECT.M), 

DHFUN.M (INVKIN.M, STMPLOT.M), 
TANHALF.M (INVKIN.M). 


traj Trajectory points to follow. 

pt Point array from intersect routine. 

alp, a, d, th DH parameters. 

dl, th2, th3, . . ., thl8 Joint values from inverse kinematics. 

j nt Above joint values in one array. 
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Figure D. 1 Pallet, Payload, Trajectory 4 




D.3 JOINT VALUE RESULTS 

Figures D.3 show the STM joint values from the FTL algorithm for trajectory four. The motion base 
values are shown, followed by the seven Module i values (Segments 1-1+ )• 


I 




Figure D.3 FTL Joint Values 











D.4 ITERATION RESULTS 
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D.5 IGRIP GRAPHICS 

Figure D.5 shows the STM at the end of trajectory four, from the IGRIP model. This figure is the same 
Fig. D.2d, with a different view angle, modified cylindrical payload, and solid model graphics. 
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